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DETERMINE FOOT TRAJECTORY PARAMETERS 
OF CURRENT TIME GAIT. 



DETERMINE REFERENCE BODY POSTURE TRAJECTORY 
PARAMETERS OF CURRENT TIME GAIT. 



DETERMINE REFERENCE ARM POSTURE TRAJECTORY 
PARAMETERS OF CURRENT TIME GAIT. 
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DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETERS OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE [Fxmin,Fxmax] OF CURRENT TIME GAIT. 
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DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
PERMISSIBLE RANGE [Mzmin,Mzmax] OF CURRENT TIME GAIT. 



DETERMINE ZMP TRAJECTORY PARAMETERS 
OF CURRENT TIME GAIT. 



SET BODY INCLINATION ANGLE AND ANTIPHASE ARM 
SWING ANGLE RESTORING PERIOD [Ta,Tb]. 
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FIG.40 



FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE LOWER LIMIT VALUE Fxmin 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE UPPER LIMIT VALUE Fxmax 

FLOOR REACTION FORCE HORIZONTAL 
COMPONENT PERMISSIBLE RANGE 
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FIG.41 



FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE LOWER LIMIT VALUE Mzmin 
AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE UPPER LIMIT VALUE Mzmax 

FLOOR REACTION FORCE MOMENT VERTICAL 
COMPONENT PERMISSIBLE RANGE 
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FIG.42 



S700 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF 
PROVISIONAL DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS. 
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DETERMINE TERMINAL DIVERGENT COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EQUATION FROM BODY POSITIONAELOCITY (Xe,Ve) AT END OF CURRENT TIME GAIT. 

qO[k] = Xe + Vxe/cwO 
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DETERMINE TERMINAL DIVERGENT COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EQUATION: 
errq = qO[k] - q" 
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IS errq WITHIN PERMISSIBLE RANGE?<^ 
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S710 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF DESIRED ZMP 
OBTAINED BY ADDING CORRECTION TO PROVISIONAL DESIRED ZMP ACCORDING 
TO RELATIONSHIP OF FIG. 44, ASSUMING THAT a= A a. 
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DETERMINE TERMINAL DIVERGENT COMPONENT ql [k] ACCORDING TO THE FOLLOWING EQUATION 
ON THE BASIS OF BODY POSITION/VELOCITY (Xel,Vxel) AT END OF CURRENT TIME GAIT 
RECALCULATED ON THE BASIS OF DESIRED ZMP TO WHICH CORRECTION HAS BEEN ADDED: 

ql[k] = Xel+Vxel/a>0 



DETERMINE PARAMETER SENSITIVITY r ACCORDING TO THE FOLLOWING EQUATION: 
r = (ql[k]-qO[k])/Aa 
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ADD CORRECTION AMOUNT BASED ON a=-errq/r TO PROVISIONAL 
DESIRED ZMP TO PROVIDE UPDATED PROVISIONAL DESIRED ZMP. 
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DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN ON THE BASIS OF 
DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGLE OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
BODY POSTURE ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGULAR 
VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY 
OF NORMAL GAIT. 



DETERMINE, AS DESIRED ZMP PATTERN, THE PATTERN OBTAINED BY ADDING BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN. 
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DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN ON THE BASIS 
OF DIFFERENCE BETWEEN TERMINAL ANTIPHASE ARM SWING ANGLE OF PROVISIONAL CURRENT TIME 
GAIT AND INITIAL ANTIPHASE ARM SWING ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF NORMAL GAIT. 
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TIME FOR GENERATING PROVISIONAL GAIT k=0 
TERMINAL STATE OF LAST TIME'S DESIRED GAIT THAT HAS BEEN CONVERTED 
TO CURRENT TIME SUPPORTING LEG COORDINATE SYSTEM IS TAKEN AS 
INITIAL STATE OF CURRENT TIME GAIT 
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DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 
AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 
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DETERMINE DESIRED ZMP AT CURRENT TIME 
ON THE BASIS OF GAIT PARAMETERS. 
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DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFIES DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



SI 406 



CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 
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DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmtix] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 
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DETERMINE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION SUCH THAT DEISRED ZMP IS SATISFIED, FLOOR REACTION FORCE 
HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin,Fxmax], AND BODY POSTURE 
ANGLE TRAJECTORY CONVERGES TO NORMAL GAIT, AND ALSO DETERMINE ANTIPHASE 
ARM SWING ANGULAR ACCELERATION SUCH THAT FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT Mz DOES NOT EXCEED [Mzmin, Mzmax] AND ANTIPHASE ARM 
SWING ANGLE TRAJECTORY CONVERGES TO NORMAL GAIT. 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION TO CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE 
ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL 
BODY POSITION AND BODY POSTURE. 
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INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING 
ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE 
ANTIPHASE ARM SWING ANGLE. 
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SUBSTITUTE VALUE OF REFERENCE BODY YAW ANGLE AT CURRENT TIME INTO DESIRED BODY 
YAW ANGLE. EXCLUDING ANTIPHASE ARM SWING ANGLE AND ANGULAR VELOCITY, SUBSTITUTE 
VALUE OF REFERENCE ARM POSTURE AT CURRENT TIME INTO DESIRED ARM POSTURE. 
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CARRY OUT THE SAME PROCESSING AS PROCESSING (S504 TO S528) 
FOR CALCULATING HORIZONTAL BODY ACCELERATION a , BODY 
ANGULAR ACCELERATION & , AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION j3 a IF CURRENT TIME IS NOT IN BODY INCLINATION 
ANGLE/ANTIPHASE ARM SWING ANGLE RESTORING PERIOD. 
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DETERMINE HORIZONTAL BODY ACCELERATION a tmp REQUIRED 
TO SATISFY DESIRED ZMP AT CURRENT TIME (TIME k) IF MOTION 
OF BODY TRANSLATIONAL MODE IS PERFORMED. 



CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY 
INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PATTERN AT CURRENT TIME. 
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CALCULATE INSTANTANEOUS VALUE /? arec OF ANTIPHASE ARM SWING 
RESTORING ANGULAR ACCELERATION PATTERN AT CURRENT TIME. 
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DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS «. 
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